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(54) Title: LEGGED MOBILE ROBOT AND CONTROL DEVICE THEREFOR 
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(57) Abstract: A legged mobile robot (1) and a control device for the robot, the robot comprising leg parts (22, 222, 223, 224) 
^ having leg part bodies (22m, 222m, 223m, 224m) and toe parts (22t, 222t, 223t, 224t) formed at the front end of the leg part body 
and allowed to bent and a bend angle holding mechanism (damper (50), friction brake (60)) capable of holding the bend angle ( 6 1) 
ON of the toe part. In the control device for the robot, the bend angle of the toe part is held when the leg part leaves a floor or at a first 
timing (tl) before the leg part leaves the floor, and the toe part is returned to an initial position at a second timing (t2) after the leg part 
leaves the floor. Accordingly, since the bend angle when the leg part leaves the floor can also be continuously held after the leg part 
leaves the floor, the attitude of the robot can be prevented from becoming unstable by the contact of the toe part with the surface of 
the floor immediately after the leg part leaves the floor. Also, the stability of the robot when it stands on tiptoe can also be increased. 
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[0088] vTS34f^t^ WPM«fl 6 dbv*5 £X?&&1®ffimft 6 nx (y) &®:fe1rZ) 0 

tfmau-dsia^:? ^r^m^mm i4mi^mx$bz> 0 

[0089] ft. ^P^Sa^-ernJ^fW^^ilb^di: l*fc^2)-efc«9, 

[0090] m9nm^^v4T^mi¥^^^ii4(Dmw^n^iry'ti^^mxm, 
[0091] M«^i*s^^-^^h^ie^ii4a«, mm^mRti^-^bMdmd^, mm 

Mtt^^^hMdmddb, ^J^Mtt^— ^hMdmdlx, Mdmdly, Mdmd2x, 
Mdmd2y^^ISi-^o MAWH^— ^bMdmddb (^<DV^fa[I]<9£>J?B^Mdm 

ddbv^sB^i-s) (MSR_hTA) e dhv&m¥~rz>z.tK£oxnm 

flt-efe§ 0 ft, _hiB-ervj£te, s^^^k^^M^^^^tK^bm 

[0092] ^BS«, jy£Wra, EHOf^-r^n^^lll^^o-Cff^^o 01O^*5V>T, 
Wdbx, Wdby, Wlx, Wly, W2x, W2y*5 £XJtWdbintfeftmfBMZ>~M^tX&Z) 0 
Vxfi^^h/VVfDX^^^fft, Vyn^<?h/W(DY)$,ft<DiM.Xfo& 0 ^.(D^X\ Wdbi 
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[0093] m9<D&m\z.mzt. m^-^mmRtit^m^nfcmm^mR^-^h 

, 114e, 114ffcfcl^Ta&&©*tflW§ 0dbv*5«ttJ«0nx(y)^3ei-«o 
[0094] 011 MP*«^^§l5ll4b(D^#Ma^^ci^E|-efe9 N WPM«£| 0 d 

[0095] Hlll^#^bTt^0j!i-§^, g^lM§P*^^>MQl^ffli-6H*^ 
O^^Flact^ @ Hlf^Mc^ ^'^^Q2^f^ffii-^^^(Z)^^F2 
act^S^, @ ^^\^PO[lI<9 1^^^^— ^^hMf If 2act^ 

[0096] Mflf2act(D^<^h/kV^'fR]^^Mflf2actv^t±ii-§o Mflf2actv 

%:n—/<7S74;V$\\A\\zM^ Mf lf2actvfilt^#5 0 
[0097] Jfci^ MJWtt«^-^^hV^^^Mdmddbv^tt«^/^l 14j^iiL. 

Mflf2actvfilt^ibMC, iSH^E— ;^hV^|B]J&#Mdiffv£r#5 0 
[0098] ft, M«7^r/V^ 1 14j E\ WPM^— ^^hV^lRj^^Mdmddbv^^H^H 

[0099] mc, ^y p y4Tiy^mm42<Dmm-x^mmwm^—^hvij\^m^Mdmd 
dbv^<D&m&tt%mirfcfr<DmmmMmj&ffimn e ffdbv£^& 0 ^ti^ v^ 

[oioo] mm^ m^—^bv^m^Mdiiwtmm^4^dh(DmKmmmm^ 

mmn e Hdbv^um^xmmwmn e dbv^#§ 0 
[oioi] &w-e, nn&Mffim&&:femz^T®.mirz> 0 mi2^<D^<Dmm^xm 

m& tkmift 1 1 4 C (D^%mm.^-ry^^mxm , m 1 ^xmmn 114 

mn 9 i y , M2&m>x.mmft 9 2^ m2^Ymmn 9 2yhmm\z.M&% 0 

[0102] H^lM^J^S^)^— ^^hXj^^-Mlactx^n— /^^/V^l 14k^MLTMla 
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ctfiltx£#3 0 HljaaJ^lflt^E— ;^X^#Mdmdlx£M«^f7l^l 14micl3lL 
, -tnSr, Mlactfiltxrt^C, «^E~;*^Mdiff lx£#5„ MJWM«^$:^ 

[0103] MJW««^^:Si^i#, ^>-^94r>^mm42(Dm^x^mi^mm 

[oio4] Mcw^. ffim^—*>hMdi£fixtmw^>Kix<Dffizmi&&xmm&^& 

[0105] ms(»mmfcmz>h^ ttnu&m&u&w&wMiii&Yz. mmmmm 
e dbv, mi&nxmmn e ix, e iy, m2^nxmmn e 2x, 

[0106] ^M^*#m§isii4h^, s^^M^*S^^J;o-c^^^^$^=3V7 0 

[0107] #*^^M«#^#iE @ m^m^mmmwmmi4ni^ nm^tntmmm^ 

IE S «JBIfWae^»Sr#5„ 
[0108] ±|E^tfflii:L-C087ti — HDf&BHfcMS^ fufa<D£n< N S34tc*3V>T 

[0109] ?fcVveS36U3i3K g^#M§P*M>t>«<5VNTa«^M«*^mU S3 
8\zMkr<*nU&nfaW&^&fcft 6 dbv, 0 nx(y) ^J&CT^TlEU &£>fcl£*L 

So 

[0110] #;l^S40^ii^ _h^e^ira*^^M«A«9^jEM§P^g^^^M 
(fit) £3*ffiU S42^^A/-eHPfp^^m$tbfcS@lfi^m^ ( 
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[0111] #cvvc\ Bll3^feBll5Sr#fl8U Z<DmfaM\z&zm&&Wiv#yh<DMW&W. 

[0112] Ell3i3\ ^s<50<DmvmMW<n&M&m1rzfviyi?m'e$>Z>o 

[0113] 0^<z>#nC ®mBMfe*ti/?hx4iy?-ll8&ffiz.% 0 -feWK^y^llS^te, r 

CLOSEJ ^ it^TOPENj (D2tt^^^S^V/N50(Df|jlJ^^— K^^J^L/cRd.clos 

[0114] Bll4«, n^VM^¥i*^#fti-^^#^^V/^50(D$iJ^]^— K&^<DS#£^ 
te<9, fi^BM&MmBWiElW.XfoZ>b%fe, ^yhU>^iHb^X\^^b^ 

[0115] mi4?4J*'^—Hz.^^xMM-r%t, m^2(Dm^mtz.^ico^v^ti^ 

hMfc'&<Dm2(D$^V^Jft2^.Xmci.OSK\ tfmUtSfos %2(D$4^?\2frh 
PfP2^^i-^fi)(D^3(D^^^t3««roPENj^^^ o ^ Jf§ 3 (D 

^^^t3d^W^2^^bTjTl5fe5i^^^^$tb§^4<D^^^t4^1^S 
SrCLOSEj^jg^tL, m4<D^4V^t4^h^\Bl(Dmi^4^^tl^X^O 

[0116] gp^, m^2(Dm^mtc^mi(D^^^tix^^22t(Dm&M^nvfc^ 
m^2tmm^tzM(Dm2(D^^>^t2xm^n^n^m^'rho £<b^, w,2<d 
?4^?t2£<Qhmmmz.%kx\ fr^m^2<DmmM<Dm3(v?4^?\3xjfc^ 
22t<Dm&ft&nmi%gfU m^aymm^x^ox^m^mKD^^^ti^h 
mmm^m(Dm4(D^4^^t4x^:(D^w^mmir^ 0 

[oii7] £iTM:i$mz-t&m~f%b^ ^^mM^ti&M4(D#^^7\4frhM^tL 
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[0118] 
[0119] 

[0120] 

[0121] 
[0122] 
[0123] 

[0124] 
[0125] 



ik\^x\ m^-r^mm^m^n^ Mfcuz&<Dm2<D?4^?t2^x(M : w.mz. 

^LT, M2<D?4^yt2Xm&ft<D&&&M } l&ir%Z.bK£Y)^ jft5fe$B22t£|U 

mn.m^mm^^o ^t^, ?>/<5o<Dffimm,mz£<>x^^22t<DmM 

m^xh^xmmB2(D^4^^t2x^hmMm^<Dm3^4v^t 
te-rz>M4<D?4v^t4 mmrtii^ &^22<D-<timmmrm) 3re/fi^22t 

•So 
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Kmm\^xvi^yhi<Dm^^^^<D^m^tir^t^x^ 0 £^ 

[0126] £^ P^2^*^^fcoTmifB^2(D^^^t2J:^#(D||3(D^^^t3 

[0127] ^^^50^^§p22t(Deft^^b^$IJ«eft^^^$lja*i!bT 
[0128] £fc, JH$fc$B22ttfS, JS§P^22m^ai^i-S^#^, SS^-ooJS 

[0129] #cvvc\ Hi6^J;tJ«|gi7^#MU^<^M©^2lllte^^5W^^lbn#yh 
[0130] |21164b^t^Hl7^, ^2^^lCfil5P^»naJ?yh©J£lf|5Sr^*r*fe^:»f®ia 

[0131] j^t. mimnmt(Dmm&KM&$:$3\^xmm-r%t, tg2mMmz&z>%M2 

22{Z.&oXU, mi6$5£X$mi7i£mir£?{^ JE§B;fcfle222m£m$fcSB222t£r# 
§ iJU tV^#m«9 KIeHB i ?i^tHl^tt222a^LT^^b^iS^i-§ J;5 fcUfco 
gp^, [Hlte«l222aSrlHl»l$*«rfclCj:»3, m^fe§P222tSrMSP^222m^*fbT 

[0132] im^222a^UTJE^fr222m^JTV^222t^Jirr5J;5^L,fe© 
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[0134] m&<DMm-±wimmmtmnx°3b%<DX\ ®.w&gmirz> 0 

[0135] Z.(D£5\Z.. l2iWl^otf4, ^V5fe$P222t^MW#:222m^*iJi-^^* 
lHl^«l222a^LT^:tbb?ri*^i-^J;5^bfc<D-e, ^mife#J£|ig#(D3Ug: 
«r#Si^dS-C#So ^ m^#222a^HI«J$^r^i!^j;oTjl\^222t^JSft 

—mz.&iZb&-£%Z>o &£>KU «7G'**222b3r18:tt5£ire, /fl5k§P222t(DW§ 
3 

[0136] &vvr\ mi8fabm2i&mmv^(DmM<Dm3mMmzm%m^&W}v^yhte 

[0137] g|18*5j;OTl9f*, ^3||Jfe^J^#5JW^^ibn7Hy^J£gPSr^i-^^:ig-efc 
[0138] ^l^ife^J^+ga^C^^*3V^tftMi-S^, ^3Hife^|^#^M$|5223(3:fe 

[0139] ^S&TV— 3r60KJ\ jTl^223t(^BU*^fcV^ttim»9^lHl«J g£^Ife»9tt#<b*L 
fcv^h60a^ ^^W-223m(Dm^i^m^°^%^^mW}^^^ , 0Uif 
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[0140] ^v/N5oofi, ^iMM^mxuM2mMmx^^<tz.^>^5otmm^. mw-<d 

223^&oTte. ®ft^«:#a*i:L-C«^V- : 3r60^«x.^r^^, ^V/n50 

[0142] BI20«, m^yv— ^eoo^raij^cD^a^-r^n^^gi-e^o 

[0143] m^(Dtu<. ^3%mm\^^uw^m*. irw^K^^i 20^11 ;l& 0 -fewh 

[0144] ®21te, n#Vhl^TO^||J]i-§^(D*^V— ^60OfljiJ^— K^ifOM 

mcDM^^^^fe. %m<DmMm<7)^ti(mi4)tm\^xibz> 0 wz., mm* 
[oi46] z.<d£5\^ ^3»ji^ot{t, n^^223t(Dm\&ft&^<v^mmmxi%w 

[0147] n^mm^mftnmmmbmmxib&tLtb, t&m&^-r% 0 -bts» 
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[0149] 022:JoJ;OT23te, ^4^M^J(^SP^»n^yh<DJESBSr^m^:ia-t?fe 

■So 

[0150] m22&£XFm23fcm1r£5i^ H4^»!l^#S^^224^feoT«, f^lMM 

m<D^U22Kmnhfht^>'^50iz:R^mm^—^6o^m^o 

[0151] ^t^^(D||^!J^(D^5t^^-oV^Tf^0j!i-§^, ^4Hife^!l^oT«, _hfBb^m 
^7V— ^60<DJMl^MSii^U ioTJ^^V— 3r60^ /[l;$fc§R224t<D 

[0152] IP^, M^V-d f -60(D#t^?ftJ±^_hfEP_high^P_zero(D^^'fit^l^Si-5^^ 
-e, iy^h60a(D^m^mmU X^X^9c^224t(Dm^-M<Dm^mmir^X^ 

[0153] J^T, ^^WlJ^Sp^lfjn^VhOflJiJ^lS®^!!]^^, jU5fe$l3224t(D 

[0154] m24«, mm-f^— *60<Dmj±m^<vfam&^i-7*tiv?mx&% o 

[0155] BI^(D^P<, ^4Hife#!|^#§f|jiJ^Iigg« N -tU?h^y^l22&mX-Z>o i?Wh 
v-df-60(Df|!iJ#^e-K^^b^P_high(^jEfi^ o A^tcfi, ©McD^tif 

^lt, ^<D?ib<D\^i?tifr&±^fcpjrm(D?4^?xm^u mfrm^rpbtv 
[0156] m25^, m4mmmK^mm^—^6o<Dmm^—h^(Dm^^ir^^ 

[0157] |l|25^-rA-^— h{^-fJ:5t-^ ^mMMKfooXfe, W>2(D$s(^/-7*t2frh 
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MS(D^V^t3^(Dm. &&tfUSc60<Dfflffl*:—\?bL>X TSEMIFREEJ & 

^^24ti)mmi±mKmmir^m(D^-^-iy^-h^mm(Dm±^±ir^ 

b&X%Z> 0 

[0158] H25«n^Vhl^ip^#l!]i-^^^^A.^--Y-h-Cfe«9, mgz&±%t% 

[oi59] ±M<DWtm\^ m2 , mmmxm^<t^^M222\z.^o\^x^ ^v/^5o^ft^.T 

[oi6o] &v>-c\ m26^hm29^mmu^(Dmm(Dm5mmm^m^m^mti^yh^ 

xxiwmmmm^^^xmMir^o 
[oi6i] m26*5j;ti?H27{*, m5mmimm^m^mti^h<D^^ir^mmm 

Xfo% 0 

[0162] m26$3£Xfm27K^1-£?^ i5|Mj[:fcotli, WlMMm^&%%:^22 

^hn-^i-^22s(y-T^^-^^^i/3^-^^^)^tt^J:5t-bfc 0 ft 
\ ^h^—^±^22s(D^mm^ mmVfcmm^^yb26<DRAM64\CAtlt$frlZ> 

o 

[0163] t°^h^n:yK50fCO^hn— EI^<£>#nC /Tl5te$P22t(^JS(M iOSC-C^t: 
i~^o fiP^, t^h^n^KSOf^hPw-^^^tjtJ^-^^^ jTl5fe^22t(D©ft^ 
^mi-^^^t-ffi^i-^o J^T, ^hn-^ir>-i^22s(D^mte^ Jfl3fe§|322t(Z)jS 

[0164] #cvvc% M5mmmKm%m^mvy$vhmmmmz^^xwim~tz )o 

[0165] ^5Hifef?(J^feoT«, Bi|illbfc^lcD^^^tl^^3cD^^^t3^, Jfl^fcgB 
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[oi66] jy^a*. m4,(D^^^\A^m^22t(Dm^(D^n^m^t'^ a* 

[0167] ^ ^(ommmm^mmmhmm^^tz.^ mm%m&~rz> 0 
[oi68] i5»ji^ot{4, ni9c^22t<Dm^n^mir^^^mn, 

^mim^^^xmM^w^rm^ir^mi^xxfmsco^^^ti, t3^#^ 

[0169] ft, ±M<DWtmU, HI 28*5^0 29 Jg2^»!l^#3^222^ 
[!Ife#222aCD[lI^^mi-5[lIfe^ir^222s(in-^y^= 3 -^[l|^ 

tK^>->3^— <£rKtf\ ioTjT\^fe§P222t(Deft^^m«J:5^bfc^a- 
6 

[0170] #cwe\ m3o^hm32^mmu^mM(Dm6mMm\^^m^wj^yh^ 

^22A%m^n^mv^yy&mWib-tz> 0 
[0171] memmm^h^xi-i, foifctt&mm. mmy^—^Qo^mi^^x^Kt)^ 

[0172] «<Z)^W!j^^^tB3*^^, ffraiLfcMSRM«^^:fefl5114c-114f(Dia 

[0173] HI30te, H6HM?!l^#§^^7V— ^eoiOftMW^E— K)&if©a^s^*r^A. 
hx&% 0 

[0174] Bl30^^i-J:5t-^ i<DH»!j^#§J^^V— ^60<Z)f|jlJ^I^— Tlockj 
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K J3\ THOLDJ , TCNTRLJ J^TRETJ <©3®0>e>Jfc5 o 

[0175] gi3itt, m6mmm\mzm3mw}v^yb<Dmfflmm<Dtp. ^nmm^mu 
<Dm&9om&&*t-7w?m'vibZo ft. mi^^mmn e ix, mi^Ymmn 

J±X#ilt>btl%Z.bfab, TIE-e«JWJSR©iiL##(n:l, 2)^X, Y©fB*it*§'lfci- 
[0176] m31K^irmmx»WWl&)ts:Z.tfe, -tu?h^y^l30&mx-. ^>-7°y-<T>^ 
[0177] ftUJfc. a^^-YTV^fffltW^— KfcL-C rCNTRLj ^H^tvO^^ 

filt£r#5o J^tPMH^— ^hMdmd^M«^/^136^ML, -^rtL^Mact 
filt^k^C, ffi^e— ^hMdiff&#5 0 M«^^/^136Ji, Hl2^L7c-?:iL<k 

[0178] -^LT, <B^E— ^^hMdiff^K_cmpl($IJ^W^)^C^^i:^J;oT=3^ 0 7 

[0179] m^xTjkvtimMtmm^^mmmnmmM e h&m, ^n&^-T* 
[oi8o] m,m^m32(Dim^ rcNTRLj^-— Ftftzmfcm^mirzrKETi*— k 

M«if^ 0 cmpLdmd^^fJ— Sc-TSo 

[0181] ^>-y p 9^T>^m^—^tvx^RKTi^m^nx^^t^(D^m^^^ 
xmm~r% 0 ^>^y^r>^mm^—vt\,x^KT\tmu^fi^ -tr^KMV 
^i3o&RErrmz&m£ti. m^i32ia-i^>^94T>^mmwmM e C m P i 

iZ^Kjret^Wtm&Mj&tlZo ^l/Zf^TZs^mffifrft 0 cmpl 

<DmikW, -K_ret* 6 cmpl£&5 0 fiP^ = ^9^T>-;*ffrJ#|I*&flfcft 0 cmplte 
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[0182] — ^-^y^T^mm^— VbL-X THOLDJ tim$R£ti&b^ -tu^b^y^ 

mmwmfi e cm P i^L-c, ^fi^.x<D\mmn^fi^ 0 
[oi83] #cwc\ M6mMM^m%mm^—*60<Dm)±mm^\^xmmirz> o 032^ 
, ^(Dmm^m^iry^tiy^mxh^o 

[0184] ®32&;ioVvrf&K1-£^ 3fe-f\ HJSIfP^^^E— ^^MVIactSrlS^B5Jhffl<Dn 
w^7^/V^140^MLTMactfilt£#5 o ^hMdmd^MI 
^^^ : #ttBic#ffi(DM'»^/^142^Mb, -^^Mactfilt^^C, fig^e 
— p^]>Mdiff£#5 0 

[0185] #Ci^ fil^e— ^hMdiff ^K_b ($IJ#P^V^) £3tC3r^ iotgtffPdmd 

[0186] ft, JifEfW^V— dr$lj^— K^bTEI^»^P<rCNTRLj^^$tL-CV>-C 
±U^b^y^-144^CNTRUM\^m^nX\^ ^^©Mtfel TLOCKJ £fc 

4<HhLTP high (® MG^fii^) l£fcteP_low (® ft /^ffifii 

^pbbL-xm)±m^^ybKtii£)£n%o 

[0187] _hfB^BiJ^^E|30^^-^— M-OV^I^-T^ ^^-fT^ftlJ^- 

$ti§o m5(D^4v^\5^hmM2com^m<Dm6W4^>^t6~kX(Dm( 

m<Dm4(D¥^>7\4-£x<Dm (Wh. m^2(Dm^.m^h-<fcmmmr (/fi^^ 
mi&) $ix<Dm) tcntrlj trntR^nZo 
[0188] Mtfcmzwimirzb, m%K2timjfeir%M<Dm6(Dy-4^?\6frb^fcmmm 
T-t%m4<D?4^?t4tix<Dmte. m^co=t^yy4T^mm^n% — n# 
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[0189] M4<D?4^?\4frhlkm<DMl<V¥4^7tl^<Dm ( 

mh, ^^mm) . mm^-^60(Dmm^-^ icntrlj ^m^ti^t 
i&ffi&ti%mm&mmir%^bK£<>x%:<Dmmt>$:Mmu x.<>xjK%^224t(D 

[oi9o] ft, ^<Dnmtefem<DnMMtmmx&%<D-x:\ mn^m^-r^o mu mqm 
[0191] m6mmm^4mmmKm^m^m^yb^mmt^xmmvfc^, 

[0192] #:vvr\ m33^xxim34^mu^mm(Dm7mmim-m^m^mti^yb 
&mt£itz>zkfc£*)^ mmstexfoZo ^x\ i7Hi^ji^ot^, /fi^^ 

[0194] Bl33tt, ^7^»!l^§^V^^5O(D0lJ^^— K^WM#^i-^-T-A-^-- 
[0195] El33^-t-£5^ Z-<OMJ&W\Z.QikZ>n"*ffl& s £~- bit, TCLOSEJ, TCNTRL 
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THOLDJ „ TCNTRLJ & TRETJ (D3^^^^o 
[0196] ^T, ^6||^i^|i!(D^^;^OV^TfiP^«o B|34{*, g^Jfefll^S^V^ 

[0197] 034^^i-J;5^, 3fcT . %^U^R±s^—^>YMsiCt^mB±m(Dn—^ 
T7^/V^l50^MLTMactfilt3r#5 o l£fc, M^if ^-y^hMdrndlrMtM 

Mdiff^#5 Q 

[0198] m^, mM^—^hMdiimKAim^^^^m^^tKx^x^My^^Mi^ 

*Rd_dmd£j£#>, ^:tLt-^ir5/h^(9*Rd_offset^P^bT#fdi:^Vy-?^«9 
*^R_d^bT^V/-?50^m^-T^o 
[0199] ft, _hfE^V/N°$(J^]^e— K£LT|2|^<D#D< TCNTRLJ tf5jgiR&;h/CV ^ 

K^:y^l54^CNTRL#J^^£;HrCV^) i#(D^a-efe*9, TCLOSEj^c^r 

Rd_close (® mfi&Wm^) *fcfiRd_open (® ft^^ftf IBtff ^0 tf**V^i&«9£ 
^R_d£LT^ >v-?50 £ tv5o 
[0200] £fc, I^P^^P^-r?)^^ ^7|IM^!j^feoTttf(3zfibfc^6^»!j(Dg|31t|ll# 

[0201] ±m&mmz.m33?4J*'^— M-ov^i^-r^, m^<Dtu<^ M4<d^^ 

K^TCNTRLJ t^^tt^o ^ ^Iszf^T^xmW^—Fft. Mtft&m 
m&^t?M4<D¥4V^\4frbm5<D?4V^t5-3lX<Dm, THOLDJ \ZLffig£tlZ 
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